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a. mm^'jy'yoinnmtmmnmtosm^mti 

^^tmz. m^2(omBtn!^s^m^(ommila:)?s^z^ 
^L-p-p*tT-rs2s*!fTsa<7>p*'y mib^j 
m<o^-imm. mm<o^s^^^^. mm(om3s^m mm 

iz.t^^^tt^n^im^tcii2mi&m(omit^ 
ismm^: HufB?ii»¥S;i*H5iBii2oaiffa^:i^si 

^^y-f HufBft)S)!)^6-»^#ti5P<l?'y l-<D!e»»c 
mS5^mxn:2:^<Dm&'J>'irtiS''htjiO. S2*0)i8P 

9\-t) ^csr3^^T fJiBm 2 oa^it** jsmr * c ir^ita 

itmme] fufBm:£03}s-f'f«cD»tuicfci,NT7'f- 
K/^>^ • ^'-r>^y-<- K/^y^fi■^oJll;gi!t!|f'tt^c 
J^;L;TpJ^<t:U p/f^iB5*l!S=&S*<!: LT^ti^S^^ 

[ii5RJi7] BuiBmi^Miaiif^RrffifiatciscTRis 



[000 1] 

[Sm±a5f'Jffl»S] ilcD5i^ttM)ie^l()P*'-y 
fflii^atcHU 1tlc2S*pi?T<D»l()P?l?-y Hcfc%^T^ 

[0002] 

[?M*roj$ffi] ^tiizmm^n^2:$iomm 
«y as LT««!*^-p-p#?T-r « ASS© 2 E#^TP <k 

^©Wl.!: LTlis «l);^tf!|«MBS 6 2—9 7 0 
0 6 ^4i«E«<Datl5«Ptf « Z. t «o 
[0 0 0 3] 

[5gW)»*L<fe5<!:-r*Sa] L3b^L^)b''6> C(D# 

<7)S¥ (ssi5) ©ftjt*\ mD©KE«■#^T■r5<!:$© 

#x.6*i-5o Bp-Ss p*'y ^(nm^n-^ismt^oT'^i. 
ni#p -y h oim-fiismztir^'^^^umr^z. t 

Jtlc. ItSiiF 2— 2 598 394* (iFfig2^9^2 8B 
[0 0 0 4] L*^LS)!)^6v *aj«iA*^*iSlL,«:ftffi« 

m<Di&iS'^S!iiiL(ommmmzwi < #^T/ 
f)'^±ii<mmm'^»rst>n^mf^m'j/i^->iztsi-^T 

*^fco LA^U #^«8Jei4*aflir«lcttP*'y l-©®J 

d^i^Sx •€-<OJSKtt»itScDP<l?'y hlct-3T»*L 
[0 0 0 5] ^;^:^Tx CO|gB^<DBW(*> ^«>i9ftLT 

fc^.^fc#^^/ v^c@•:5^^T p<J^ -y h cD3e»«-$iJ» L 
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[0 0 0 6] 
[0007] 

n'^-t<^0mi'^m{zmL7htsmicLtc<DZ\ hoc^s 

[0 0 0 8] 

Ti'^y h^mizt-ozco^^mo^mmm^mmr^. m^ 

r^mw}=E-^zm7Ti'r^) o memcDmw (») ti± 
A^enitc. m(Dm^\B\mm<Dmm («) i or, i ol 

(x^^f^) omm m) i 2 r, 12 l. ma-f\, 

(y*[Rl) (7)18® (tt) 1 4R, 1 4L. KgP(7)t:° 

•y^:??fRj(7)MS!y (tt) 1 6R, 1 6L. s«spa)try^ 

7^[p]CD^®5 («) 1 8R, 1 8L. IWlP-;b7?fpICD^Ii5 
(tt) 20R, 2 0L<5:^'PTfcU. '^■<7)TgPtc:t*S¥ 
(J£gP) 2 2R, 2 2L6^5X«*n^<t«C. »±ffijc: 

t*ffl5|1*gl5 (Sft) 2 4^^i9tt6ti. ^copqgptctiSOffliL 

(tt) 1 0 R (L) , 1 2 R (L) , 1 4 R (L) A^S 

4S^T3fn. ^/cjs^iptiv mw m) 1 sr (d , 2 
OR (L) ti'i^mm^ti^. ^tc. WLmwtmmmto 

[0 0 0 9] CCZ\ l^gl5U>^2^i;fe:6cOS^c-Pt^T 

filmic 3 :iK7t^m^mjt^ztfi^z^^mzmm^ti 



-3 24 2 1 8^. ^mW-S-l 84 7 8 2^) *<!:tC 

[0 0 10] czz\ m^ \,z7jkru^^y h 1 itisi^Zs 

X, Fy, F ztt<D:^\P\^^J(0=E-:^>bm^tAx. 

[t'jiimmm7.^y=F3stmii^^tiZs mm^m^ 
«iair^o mt. pi*gP2 4o±gptc«. -*t<7)fi*^-t 
v+^4 0, 4 2*^iga;*'ti> x-z^®i*]c^ztttc)ttr-r 

-^tct*. ^(T^Hea^^ij-r^p—^^uxvzi-— jfjb"^ 
isitsn^ mMctsi^z^mm(DmMb=E-^m<D^(D 

(D^^Tjkr) o iin6-bV-«t3 6&^(7)!±J:tl«H9S3tfc 
fl(?^*:gP2 4^<DUmJ--y h 2 etCjUetl^o 

[0 0 1 1 ] m2{m9=L=i^y h 2 6<0i¥«B^/T^r7P 

^c:^^:tel^T^^a^-tIV^t4 0. 4 2;5:^<7)ai:^tiA 

X5 2^^LTRAM5 4lC^enSo ^fcSSft^- 

^5 6^ftLZHAM5 4mzXtl-in^tmc. JS±tt 
X-r*y^3 8*(Oai:/Jt*«^JKS6feisl!»6 2^«Tfliailc 
R AM5 4P»gtctSM^n^o $iJfflirL-'y hF*g[Cti>||S^ 

meAt^^mf^tiZ^v. ROM6 6tctt«ft*tiTi^5 

U D/ASJftS6 8J&^>LT+^— /1^TV3^lc2lttl-r 

«fcS/T^0io<. xv=i--$fta^i*F/'v^«iHia 
[0 0 12] mi^Zs *sijffl)^»cDgj<^^itt0^-r^o 

[0 0 13] |gl3tiEn tC/T^L/cP/lt^y h 1 iC-Ol^Zs 

z&^o ^ib:i-y^-cyzmiLztsi^rzw-im^mm 
snft<jistu p/i^^y h 1 «l^lt^tl/^:#^T/\''5?-> 
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[0 0 14] ^-CTCro^gB^lCfct^TliUAlC/T^-r^ 

u^mxTma^micm-^^mt^usi^rco kit. c 

5Ci6<T-?5o (E15lCBijm:^|^<Dv I2161CSS:&IR1 

J (e) • e + x (6) • e* +z (e) 



Kl+f 5= MTilit. ^/^*^y>5ZMP (zero moment poin 
t) <D«««ffl^,^T. Z M P 

[0 0 16] «±<Dffi^Jb^6. 01 iCg^LfcPjKy K 1 

(omSilsm^it. W^^aimzmtcti^T'^i. ai© 

[0 0 17] 
[»1] 

+ Y (9) • F=M • T 



flU e= ( ^ 1 . 8 2. • ♦ • • , en) : D#.> hOU 
T=(rl, t2, rn) : UBiffi h -rPi? 

F= (H. V) : mma^vpmn^:^ 



[00 18] tZ^T\ CC0SiJfflllCfct^Ttil213lOT^-r 

(i. m^Mq i <tBflIi5ftJl^fIq i r i:*-e»2 tt^^r 

ri=kp' (qir — qi)+kd 



[0 0 2 0] ccvms. eizmtma^ m&Mq it 



d, f vl*. las^Ok p, kdlckv, kc. kt* 

[00 19] 
[»2] 



q i r — f V • q i 



[002 1] 
[»3] 

qi=0i-9i-i (i=l~n) 

[0 0 2 2] »2©a;«»3oa;i::j:-pT';v<7ft7a 

[0 0 2 3] 

[i»4] 
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T = K r-er + Kr-er-Fp 
+ d id 0. Or) 



-F V • ©- I m • 0 



mi.. K r : -mt-^m. F p , F V : y>f vVtM. 
^ 0 r : ^E^HSTSflftKs 

Sr. e r : aeiv y^n. nmm. (i®^^) 



[0024] ftis KSAcDJI-iLd (60, 00 r) . EP 

«a 5 a)m\zm.r z. t «, 

d (fl 0. ^ 0 r ) = 



[0 0 2 5] 



kr'<90r-fp'50 + kr-e0r-fv-ff0+nl • Im-^O 

0 

0 

[0 0 2 6] CCT, f»4©S«»1©*f!:«ALTfii [0 0 2 71 

(J (0) +M - Im) -e + X (0) - 0* + Z (0) 
4-Y (e) • F -f-M • F p • 0 + M • P V • e 
+ M • d (e 0 r, e Q) 
=M-Kr -Or+M-kr -Br 



d (eOr. (90) =-d (d 0, 6 0 r) 



[0 0 2 8] cosfceics^-rjCJbV mmn-^t-mmaji 

T(*gffi5SI50 r (*65t>tft)t) , 0 r K-y h mSciMm 

m) tr^^. ^rzm.^<o^T^is.w■nmeo (mam 

ft*-a:5<i:S¥^ig0O3K'5V^fAlc^ibL. a 6 cost 

60r-0. flOr-Os 50 



[0 0 2 9] 
[»7] 

■=0, eO = 0, '(?0 = 0x 



d (^0 r, e 0) =0 



[0 0 3 0] BP-S, a^3^gi§0 r, 0 r K'V htS:¥iSiiS [0 0 3 1] 
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(J (6) +M - Ira) -e + X (8) -8* +Z (8) + Y (6) - F 
+M«Fp'8+M'Fv'e 



=M-Kr •Sr+M'Kr -Br 

[0 0 3 2] -y;. mS^n-^-7n(D^&LK r ^ii'^gjg 



■5 s 3S1 o-^rmizn^, 

[0 0 3 3] 
[»9] 



[00341 m^o] 

[0 0 3 5] ^aytsm. »8<o^i: *mne^K»^ ^<r> [o o 3 6] 
^t'^iS.*)±-o. [3S1 1] 

(J {0r) +M- Im) -©r+X (9r) 'Or'+Z (©r) 

+ Y(®r) 'Fr-hM'Fp-er+M'Fv'er 
- Kr-er+M-kr-er 



[0 0 3 7] CCT's Lf#U#a'<fc««Cs 

-V0r«fflC^«^: (ip-Bs il-ad (Or, 6 0) = 

0) . HCitCcfc^sS^OXU (liM) ^AO-hf^i: 

T = K r -er+kr er-Fp 



[0 0 3 8] 
[US! 2] 

e=e r +Ae 

[0 0 3 9] itf-pT> C0XU^ffiIE-r§/£46lC. 84 

[0 0 4 0] 
[!»1 3] 

e-Fv -e-im-e+Ku -u 



Iflt. U= (u 1. u 2. 



. un) , d (^0. ^ 0 r ) =0 



[004 1] 1 3<DiCtt¥liK®*Sltfcii-5, 

ip-6 (eor, eo = 0) <Dtt!glcfctt«MiSft*t-?l? 

[0 0 4 21 ^:<3!)^f]E«u®llaJ^^:-^l,^T:*:^c^^W■r 



K^W^^-yQ r i:XUA0TSLrcili!i??Sa;i:«: 

[0043] 
[»1 4] 
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(J (e r +Ae) +M • I m) • (er+Ae) 
H-X(0r+Ae) • (e r +A0) » + Z (0 r +Ae) 
-HY (6r+A6) - ( F r + A F ) +M • F p • Or+AG) 
+ M • F V • (e r +Ae) 

=M'Kr •er+M'kr -er+M-Ku'U 



[0 0 4 4] K®©IH]^i^l^+5^•/J^^^,^i:■r«<!:, X^H [0 0 4 5] 

(J (er) + idj/ae) r -Ae+M- Im) • (er+A'e) 
+ (X (e r) + (.dxyae) r«Ae) • (er + AS)* 
+ (z (er) + {dz/dd) r • Ae) 

+ (Y (6 r) + idY/a e) r-Ae) • (Fr+AF) 
+ M«Fp' (0 r + Ae) +M ' F V ♦ (Or+Ae) 
•-M-Kr - er+M-Kr - er+M-Ku-U 

iib, idjyad) r. iax/ae) r. iaz/ae) r. 
iavyae) T e = e rtiomsiif^m 

[0 0 4 61 ccT% XU/:iea)2^)^a)m^f!mt [0 0 4 7] 
%>t. HI eoi^tti^^ m^ 6] 

(J (er)+M-lm) -er+XOr) - ©r'+Z (er) 
+ Y(er) • F r +M ♦ F p • e r +M • F V ♦ e r 
+ (J (er) +M- I m) • Ae+ {d J/ao) r • er • Ae 
+ 2X(er) •er-Ae+ {ax/a$) r ♦ er» • Ae 
+ {azya e) r -Ae+M'Fp 'Ae+M' fv ^Ae 

+ (ay/ae) r-Fr-Ae + Y(0r) af 
=M'Kr -er+M-Kr -Or+M-Ku-U 

[0 0 4 8] B§fii5S+^-**^S31tCiifif-r5<!:*fi)63l-r [0 0 4 9] 

1 1 ICT^ LfciC J; *). » 1 6 <D^Wj4ft(WlC» 17 [US 1 7 ] 



(8) 
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(J Or) +M • I m) • Ae 
4-(2X(er) - er+M-Fv) - AO 

■t ( id jya 8) T -e T + (dxya d) r-er* 

+ id Z/d r -H idY/d ^)r-Fr+-M-Fp) 
+ Y (er) • AF 
=M • Ku • U 

[0 0 5 01 S-eic^ J (0r) W:ejcJ:5^b3B«/h* »&*/hBI«fl«fiKy3iOo 

K^-'Z.t. X (Or) lifiAVjNjtNiii:, 18115^+*—*;© [0 0 5 1 ] 

2X (0r) •er<M-Fv 



Ae 



id 3/ae) r • er + (^x/^e) r • er* 

< id z/d d) r+M ' Fp 

[0 0 5 2] J:oT. ai 7©att»1 9©aitca-rc: [0 0 5 3] 

(J (er) +M' Im) - Ae+M-Fv-A© 
+ ( id Z/d e) r + id^/d e) r ' F r+M • Fp) 
H-Y (e r) • AF 



A6 



= M • Ku • U 
[0 0 5 4] ai 9©iet±*iT/\°^->*^6<DX 

a U (* ^OX U A 0 oaift^f iJll-r i.JS'PF* <fc ^ o T 

■So j;oTs xuA0*^(c-rsi*'(t»u«s**a-i± 

U = Ud+ (M • Ku) • Y (9 r ) 

[0 0 5 7] ifc2 0(OSC«»1 9<Da;iCfcA-r«ts » [0 0 5 8] 

2 10Jin<i:&5o [SS2 1] 

(J (0r)+M - Im) -Ae+M-Fv-A® 

4- ( id Z/d e) r + idy/d fl)r-Fr+M-Fp) 



[0 0 5 5] XUA0*^flc-r5SfP«U(DKm 

^c•pt^TS^^•r«. c cTi*ff«u ^» 2 0 (d«ic« l 

*^3b\ ctvWBuiB Lfc 6 tt:*3-b vy- 3 6 6^6«ll±l-r « 

[0 0 5 6] 
[1K2 0] 

AF 



Ae 



=M • Ku • 

[0 0 5 9] U«-JS2 OcOiC^-ffll^TI+lf-rtl 

:^i^i!)5^AF*'ii-»/Jx*<. »2 1 roJC^cteo^T^i■^Li: 
*'/j:■r^:^:#<T■*^%6H^^ AF = 0i:Us IIS2 0<75iC 

<Dm 2 m^tmt^ z.trs.<. j.xT<7)i«f^« u 0 ^■ifai-r 



A6A F ^5 0 i:T#-5«:&JS^T'«5<. 

[0 0 6 0] j-xTv ^■<o»f^F«u0®sai^c■pt^TS^^ 

[006 1] a2 1 ©iCliA0ltBlt-5l«}^:)&SiCT» 

^ts^ib. t^^^^*««^ll*a^c«3H«fflt^Ta2 2<D8l^c 

[0 0 6 2] 
[iS2 2] 



(9) 
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X = A • X + B • U 
y =C • X 

x=(A^l.A02, •••.Afi'n. Aei.Afl2, •••A(?n)* 
u=(ul, u2, ♦ • ♦ •un)*«=U^ 
y = (A« 1. Afi 2, • • ♦ • . A<? n) * 



[0 0 6 3] ccT\ Siiu4iii.u— s?asiicd;y. us 
2 3 (omzTrr 2 ;>:ffjxCwi¥ttM» J ^•g'jxtc-r « u « 

[0064] 
[»2 3] 

oo 

J- J (x* Qx + u*- Ru) d t 
0 

[0065] 
[IK2 4] 

u -= — K X • x 
[0 0 6 61 msmLJ^S'Hzr^Zitlt. »23<0 

S„ cfcoT. ia2 4©ie*^eifiE» u^it» 
[0 0 6 71 -5?. ^^S»»AF-¥>-7h'Jy?ZA, 
iClis »2 5W«llcarc:i:6^T€5. 

[00681 
[»2 51 

x=A • X +B • u + d 

y = C • X 

[0 0 6 9] $fc> sigu=if'iU— j»assicj:ti«; » 
2 6 IcStT 2 :*fKSecol¥fllilll» J *«/j>tc-r * u tia 2 

[0 0 7 0] 
[i)f2 6] 

J= i (y* Qy + Ru) d t 
0 

[007 1] 
[»2 7] 

00 

U--KX • x + K i • J y d t 

0 

[0 0 7 2] Si^2 7®ICt.^ SL240ittmmiC. 
[0 0 7 3] CUT: u^i+nt^tcibl.cii'f-OK 



a#-> hOSI3fl!iSP2 4ti:isiU-r>ttfcffi«sHry9-4 o, 4 
a 3 cDa;«a 2 8 wtSltcS < d i: jbT'* 

[00741 
[«2 8] 



q 1 


= 6 1 


-6 0 


q 2 


= 62 


- e 1 


q 3 


= 63 


-62 


q 4 


-6 4 


-6 3 


q 5 


= 5 5 


-64 


q 6 


= 6 6 


-5 5 



[0 0 7 51 CC-Z?. ll!i*gP (Sf*) 2 4<Dli^fte3 

l±1S$4-bV9-4 0, 4 2f-^aiT-3-5C:i:*^e, Cc^^ 

j:ya2 9<3!)a;*i«^y3io. 

[0 0 7 6] 
[a2 9] 

6 3 

6 2 = 6 3 -q3 = 0-q 3 

61=62-q2 = (^-q2-q3 

6O=6l-ql=0-ql-q2-q3 

64=63+q4=0+q4 

65 = 64+q5 = (f + q4 + q5 

66 = 65+q6=«> + q4 + q5 + q6 
[0 0 7 7] .feoT. XUAO(±a3 OO^Ta-rCt: 

[0 0 7 8] 

[a3 0] 
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Adl=^l-51r=«5-q2-q3 - (0-q2r-q3r) 

= V!>-Aq2-Aq3 

A^2 = 52-92r-<ii-q3 - (0-q3r) 

= 0-Aq 3 

A« 3 = d 3 r = ^-0 

Ad4 = &4-e4r = ^ + q4 - (0 + q4r) 
-0+Aq 4 

Ae5 = e5-95r = «* + q4 + q5 - (0 + q4r + q5r) 

= «fr + Aq 4 +Aq 5 
A(?6=ff6-i?6r-0 + q4 + q5 + q6 
-(0+q4r+q5r+q6r) 

=^+Aq4+Aq5+Aq6 



iSL^ Aqi=qi— qir, i = l, 

[0 0 7 9] .toT. l!S3 0C0iCl*x -^i-'J'y^^Xmm [0 0 8 0] 

TIS 3 1 cDttilc^f C i: 5o [» 3 1 ] 
X =E • q 



fib. 

x= (Atf 1 , Ae 2. 
q= i 



A« 6, A« 1. Ad 2. 



A<? 6) * 



Aq2. 






Aq 6 




Aq 2. 






Aq 


6) * 


1 -1 


-1 


0 


0 


0 


0 


0 


0 


0 


0 


0 


1 0 


-1 


0 


0 


0 


0 


0 


0 


0 


0 


0 


1 0 


0 


0 


0 


0 


0 


0 


0 


0 


0 


0 


1 0 


0 


1 


0 


0 


0 


0 


0 


0 


0 


0 


1 0 


0 


1 


1 


0 


0 


0 


0 


0 


0 


0 


1 0 


0 


1 


1 


1 


0 


0 


0 


0 


0 


0 


0 0 


0 


0 


0 


0 




-1 


-1 


0 


0 


0 


0 0 


0 


0 


0 


0 




0 


-1 


0 


0 


0 


0 0 


0 


0 


0 


0 




0 


0 


0 


0 


0 


0 0 


0 


0 


0 


0 




0 


0 


1 


0 


0 


0 0 


0 


0 


0 


0 




0 


0 


1 


1 


0 


0 0 


0 


0 


0 


0 




0 


0 


1 


1 


1 



[008 1] m.-DT. mpnm2 Aomm^ i izmL 

[0 0 8 2] 

[83 2] 

U-- (Kx • E) • q--Kq • q 

[0 0 8 31 »3 2os«. mntu^mimi 4<oni 
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[0084] 
[IK3 3] 

[0 0 8 5] 137*^61211 1 ttHSIx— ?TS5A'!. C 

T-*/co in-6s ia76^6l219«a.jfu/ t-;£>tS5£J^tt^ 
K t T3£JtWOJSMMIi5ft € 3 fii!)3?lcXx -m\z.m. 

3-6E17«lllfi5ft+f-/1t-<D*K^jy|^€-. I18l*»3 

3 J: ^se^^bsijfflKDis^*. la 9 wa 3 2 <o^\z 

i^i5Uz.mm.\.z.2m.mmm^<o^m^-'i'^7j<\^xiii 

*). 0#«IMi5ft*iJW©*'<Dli^«, 01 I3!i«» 

3 2C0^lcJ;SS^'(kSiJffl)C0Ji#^n'x-r» CCOH^ig* 
6^eW66^'S:aitC> IIS3 2<t)^lC<fc5JS#<k»3 3©5S 

[0 0 8 6] fSs ±gB(i»2 7(c.T^-riC{ct,S^U IrI 
iCt.^ < lRl«SlclSSBS<k-r -5 C <!: A"!-?-* So 
[0 0 8 7] «±*Ma^LT. 01 26^601 4<07 

fSs cne<07P--^i'-htt, Ell 5^^:5^f*^70 
[0088] isi 1 2 i,n&m<oi^s:^nm(o^mm^My 

P- • ^i'- it-rs 1 Olcfct^TMHSftS'ft 

filq r, q r K'y h^sS^3^.t)% ip-fes P'l^'y h 1 <D*J 
h-2 6*OROM6 6tC«E14(C/X>-rtitC. * 

nmmq r K-y h (ttlctB^ftlS) lCiS«^^**i. S 
1 OT'tt^ro^SSTTtlfctt (I^SJ t Jcfcf+S) 1 2 

[0 0 8 9] ;^^:^,^TS 1 2 ^Cjt^T••?•©gia5^c-Pl^TII 
WOftSqSA^U S 1 4lCJtA,T0^«)S!;6^6l«!a5 

■ps 1 eiztsi-^Tm^mqj. mmnmmq> K-y h^A:^! 
Lv S 1 8^cfet^T!tleft)tq<^:a«ft^q r <5:*^6M 
i55ftfflMAq*»ajU S2 0^tfct^TilS3 2»S^,^^i 

a 3 3<D^c<ot^•rtl*^«fflt^T^•jE«u«l^alr« 



as 3coie*ffil^Si:^^iS 1 8lii>>>:^-r 

ics2 0T»t±iLfcfii^flD»u ^-roii^-y— ^Tv:?" 
ictU^r*. «^.^r. S2 4T56«iA'«««6Urci:W«T? 

;^cDMSi5^cot^T^Hl«l^c$lJ^^pfii^sl{^L. i 

Buie L/iilt^Xf -y ^ 3 8 *^6^^ltil-r So 
[0 0 9 0] iSv CCT'fSSitr+xi.'^^cl.htts S2 2 

MOSMBKI 8, 20R (L) . 3^J#S©KMii51 6R 
(L) , 3tltS©flaWiS1 0, 12, 1 4R (L) . 58 

SJPcoflgKifi 1 0, 12, 1 4L (R) . mma:>m^fSii 
6L (R) . mm<DS.^m^ 8, 20L (r) tu ^ 
omTm^m^tsam-r^mzLt!:. fin-e. «^Lfc36» 

OUmizm^t^ C i C l^llS5^«$frs«l{:: 

[009 1] 01 2 7a-'^-*'-KDS2 4T'5fiMI« 

tl!3<!:!|!iJSlT?nsi*liEll 37a- • g^Y- hlctifoT 

Lrmmr^t. Jt-rs 1 0 0*^6 s 1 0 4»ctet^Tii 

mic^-^^Mmm^WibLtc^. s 1 0 etcitA/TBuis 

fcSmh;U^«A?3U S 1 OSTavy^'TT'VX* 

^m^mi^zn'yo m^^rs 1 1 otcfct^T-9— 

ffiv c <>:<J5S=i>7'^7'VX$iJffilfiim<!:ffiIE«u i:«-<jP 
gLfcfii:&-y--*'7v7"icai:^U SI 1 2TPV75 

^i:oo^TigB$6<l^^:i^s^J3I■ro i^. zi<Dm7Pimt. mm 

0<3!)«iE«u«)fiH*, HI 27P- • ^^-h<DS 2 0 
[0092] lai 37P-'^ + - HCfct^TS 1 1 2 

7P- • f^A-- h0s 2 0 o*^es 2 1 4^c^i^oTilS^P 
sit^©$yfflfii«^i*^-rs*\ cn«s 2 1 oomiEm. 
u 2 0 (ont-^s^^-^n^^^mm. m 1 

2 7P- •5^-V-t-<!:Ipl«T-2feSo t^. C:Zl:WL2 0iZ 

mLrz^^m'^^Tmwnzm^mi^Wiiit^mizLrci3\ 

A F *^iLi:# Tltltf a 3 2 «fctta 3 3 3b^6 JIta LT 
tm<v jSlciSfflHci^:/D)b'ifFfflrs<!:*l*s Ell 2 7P 
- • ^^-fr-I^OS 2 Olt33U^Ta2 0«^g46rcS:Of 6^ 
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[0 0 9 3] ccTwMLtmmmmjom9i-<D=^ 

ISJ«M«3^lRl©iI«l«7)Ji&tcfttt:6«Hc«-ri:. 

00 

J-S (q I 
0 

4-q4 ' Ad A* + q5'Afl5« + q6 ' A$ S' 



[0 0 9 4] 
[»3 4] 

1' 4-q2 ' Ae 2* + q3 ' ABS* 



+ r 1 
+• r 5 



ul*+r2'u2'+r3 
u5'+r6-u6*) dt 



u3*+r4-u4 



[0 0 9 5] zLowmmwiJitmioxiyia e > tm^ 

Su i LTt^So SiSU^aU- 

x=llsin51+I2 



[0 0 9 61 -^-CT'. C:©«IWtCtet'>T»4 2S*tT0l# 

(x. y) ICXVAx. Ay6''Si;/cfll^«%^«. C 
[0 0 9 8] 



[IIS3 51 

s i n 2+ 1 4 



[0099] 



[0 100] 



+16'sine5+16-sine6 

[»3 6] 

y=ll •cos^H-12-cose2+14 
+15-cose5+16'Cose6 



s i n 9 4 



c 0 s 0 4 



11- 

+ 1 4 
+ 1 6 



[I!f3 7] 

cos(91 ' Ae 1 + \ 2 • cos52 



c 0 s ^ 4 
c 0 s d 6 



[0 10 1] 



A 4 + 1 5 • 
Ad 6 

[!IS3 8] 



A9 2 
c 0 s e 5 ' Ad 5 



Ay=-l 1 • s in^l -Afll-l 2 • s i n d 2 • Ad 2 
-lA'sinaA'AeA-lS'Sineb'Adb 

-l6'sin$6'Ae6 



[0 10 21 Ell eiZfntmc. 5SfflI(Da«€5feflL« [O 1 o 3] 

(x, y) A^SroXUAx, A y(JDffia±©XL/Ap [a3 9] 

a3 9fl!)»tce«iHlT*-rc^:Ai«T$«„ 



(13) 
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^((ll-sin^l)' + (ll-cos51)*) - Afil* 



+ ((12 
+ ((14 
+ ((15 
+ ((16 



s i n (9 2 ) * + ( 1 2 
s i n 5 4 ) ' + ( 1 2 



c 0 s 9 2 ) M 
c 0 s 9 4 ) * ) 



sines) * + (12'COsfi5)') 
sinfl6)* + (12-cos(96)*) 



Ae 2 ' 

Afl 4 ' 
Afl 5 * 
Ae 6 » 



al-Affl»+a2-A52'+a4-Ae4* 



+ a 5 • A5 5' +a 6 • Ad 6 ' 
[0 10 4] C(DiC*^6^e6^*«»i:. a«S5tffiai)b^ 

3iSlcS5ttt«©XU«<l*iE-r*c:i:««-e#*. m 

(DXUcW-r^S^^SfcjSUTS***^**!:: i: tr 



r 2^/J\3-<rn«m\ c:<0»lc. ^^fbMffli 

[0 10 5] 
[»4 0] 



J-y°(q7 - Ap* + q3 'ASS* + r 1 ♦ ul* + r2 • u2* 

0 



+ r3-u3*+r4-u4'+r5'u5*+r6'u6M dt 
(a 1 - A^l* + a2 • Ad 2* + a4 •Ae4* 



00 

J (k 

0 



+a5-Ad5^+a6'Ae6*) +q3-A03* 
+ rl •ul»+r2»u2' +r3 -uS^ + r4 •u4* 
+ r5-u5='+r6-u6*)dt 

[0 1 0 7] lai 7it:ti^mom2mmm^^^rfn>y 



u 5 + r 6 • u 6 * 
[0 10 6] ilODllfifi«lJtt±se®«l<. BifiSft-y— 

^ - V A'^^S? L 35: IHI aSSffi^^^Tfl. * IC©^ 



mr'boiT'Si^. coma. mtELtc^-OKx. ses 

ic/Txf tti < , Jisfijaicjis uTfijis-r s^icsfig ufco 
[0 10 8] ztuz-oi^zmmt^t. ^ati^sufci: 

iSSift<0«i!)A':7-f-K/^>^';U-:?'rtTJti|iS?ns 
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S«T-B«& a > k: n - ^ tf^iii^trj: c TIHI*^% f^T^ 
[0 10 9] C(^l«SiOJlH«S)l;^Jfi^*^Mil-y:-r\ 

«l#/j:-ti:5ai<!fiSfi)6L/c. IP?. 131 9tC5^Lrc«Slc:s 

Af, Bf, cf ^WLnmmzt3i.^zmm.mMt^cti.cj:. 

[0 110] 

z =A f • z + B f • V 
u = C f • z 

[0111] **)5s«uo»^> m 1 2 yu- • h 

©S20. |il147P— - ^^-V— hroS21 OT'OffiiE 
[0 1 12] *IISS«<J«S^<b»JSPIR (fiiiU'^PaU- 

CiSSE^^^Tr « <i: * t^lce^ LfciSi^^-^^-r « C 
T t BiSJSa V tf a — «fflt>T#f«!f^«H»-r«<eSS«« 



[0 113] ISiiv ±SBL/i:miv m2||SS«yit»oT 

s-r5«icLfc*\ (p) »«tM* (/\) tc 

[0 114] Mlctt. H4tc5^Un:«Hc. ^tr/'f^-V 

[0 115] MlCliv il<0flW€-2S#t7CDlJ)iCi^i()P 
<. 1S^l^L{*3EJJLh<0MISC»»P*tvHCt,S^ 
[0 116] 

[^0^055!)*] if^R3l13Ilt*oT«s DxC^KiP/ti-.y 

*ijffli|il«t±s B5IBRlTS©J*fP«l!:)a»**xfcm2Wj*1^ 

[0 117] g|^^2^(DSIB(C%7T(j:v SUfBIH)^^ 
il!lP<|i>y f>««x ■€-tHcaiBi*-ti*«»2|E<0Pas 

^mmr^mzm^Ltc<oz\ iBsi=?B2<o}»ff««s 

[0 118] S!:^^3^cDSIHlcfe-3Tl*, SOIBM^i^ 
»p<K'yh*\ »*<t:. ■¥-tHC« 1<DB8li5«^LT»ie 

<D$t«Bi<r]^itm2(Dgsii;%«i^i><b^(c. i^m2coBiiiii 

ej. ^i$M<D»3MBi. ^nm(om^KV5. asnxosi 

/■cffi5yliffi^c'>&<^:tg|J»w^c^i^oT^ suiBm^©^ 
f^«tc« 2 <o»ft»«tt)ii-r ««tc««K Lfc<DT. mm 

[0 119] SI^]I4^<9l£ia(e«oT». 
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[0 12 0] il^JISJSCOgaicSoTl*. BuIBIffllie^ 
S*|i:<ks •?-ntcmi£DMSi5:&^>LTiS!ig 

nL-o-omyt^2&mmout^'y Km2 

[012 1] l»^^6«<D^S«(Ci6-pT«s 7<- F/^" 

[0 12 2] nmm7m<ommizib-z>Tit. ti-y 
[01] c(ommz%^mi(.&W}am'y ^(Dvmmm^ 

[02] El 1 jcg^-rtyamz^-y KOIttW:?'n •J'BTft 
[03] E2{c5T-r*jaiii--y h<D*Uffli©-5-B©B8l!5ft 

[04] 03ic5^-rMii5ft-y— *'^ic. croie^rwai 

So 

[0 5] 01 iC/XvfP^'y hWM^?&lRj«jlS)«'5^v"rSi 
^0T«3<, 

[06] 01 ^z^^Ta^'y h©S:6*[Rl<7)jII(i*5^f Itt 
«^0T»5, 

[0 7 ] 0 3 lc,TT-r Ml5ft^t-?K3S©*^«« jlfc«$ 

ic. p<K-y hroSfcftSSProSM^IS^^BU^T^lRltcXx-y 
:n«l<: 3 iSffiV^ i: *<Dt5gtt=&.Xv-ril®lx- ^ 0T» 

[08] 04tCSRr»2©a^««jMlJIL/-c«^©07 



/cm 2 oiftf^a^fim l tcm-^nmrnf- •j? 07$ 
[01 0] 07i:i^«lot,oz**oT» P'-P-y hroSJt 

[01 1] 01 ot^m<o'^oT^$>-3T. mAiCTjirm 
2 (ompm^mm Lrc«&oii»x-5»0T-»5o 

[01 2] 02a5SiJ^Bl^!IC»i!ifP^/T^-r7P- • 
hT'feoT. >tS3£JtK9tD««J»filj*^^^-r7P--^ 

[013] 01 2i:lll»<Dt©T-*oTs «il6B$0=lV 

7'7'r7'vxsijfflsso*jianij*s«5^-r7P- • 

[014] 01 2i:|Wl«lc73tCDT-JBoT> MSSEitW® 

[01 51 01 2*^601 4izmLtc»m^m^mmr 
[016] 04^c,x^■rm2^Dalf^»*lt^ti■r*<!:#©5f 

[017] *S|B^C7)m 2 *J8«U«5^-r0 4 1 ra«l<DIK^ 

:?P'y-5'»0T-»-5o 

[01 81 Sl*Jfi«U©7-<-K/^y'^y'rv©fflSft!» 

!tttt^/T^-riKRBitftt0T-£5o 
[01 9] m2IISfi«!)tD7-f-K/\"'y^y-rv©Ji»lit 

ittt«5^-rKWitit0T»«. 
[^«<oSiqii 

1 wi^i^ibP'it'y F {2e^^TP*■ 









2 






1 0 R, 


1 0 L 




1 2 R, 


1 2 L 




1 4 R, 


1 4 L 




1 6 R, 


1 6 L 




1 8R, 


1 8L 


^nm<D^y^:^\p}(omm («) 


2 0 R, 


2 0 L 


j£Ma5<;)p-/u:&i^<DMa5 (tt) 


2 2 R, 


2 2 L 




2 4 






2 6 






3 6 






40, 42 
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(17) 



4 5 7 8 0 



[02] 
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to 
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1 
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I 



00 
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<j 
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(23) 



1^18^5-2 4 5 7 8 0 




(24) 



!tt^^5-2 4 5 7 8 0 



1] 




o 
o 
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n 2] 



iftit'tfi qr, qr fgj^a^ 



SK) 



Mlisft q A^j 



■SJ2 



vc = kp'(qr-q) + kf-qr 



■SM 



■SJ6 



S18 



S20 



S22 



S24 



(26) 
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m-\ 3] 



■SlOO 



■S}02 



vc = kp«(qr-q) + kf«qr 



■'SJ04 



± 



■5106 



■S108 



(vc+u+m) 7lx'7>:fizai* 



SllO 
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m^ 4] 



i^^g^^^i qr. qr gg^ji^^ 



■S200 



q A-fj 



S202 



vc = kp'(qr-q)4- kf 'qr 



i^^n^^Ak nii/^^Alh 



■S204 



S206 



5208 



(vc+U) ^i^-- 7H'7>3'"iztB:/] 



S214 



-S212 
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m^ 51 
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II 7] 




